广度优先搜索(宽度优先搜索)迷宫问题

使用队列,层层递进,往下扩展。

     5 4
     0 0 1 0
     0 0 0 0
     0 0 1 0
     0 1 0 0
     0 0 0 1
     1 1 4 3

(5,4是迷宫的行和列,0代表空地,1代表障碍物,1,1是起始位置,4,3 是需要到达的位置)
        7
 

#include<stdio.h>
struct note
{
	int x;
	int y;
	int s;//步数
};
int main()
{
	struct note que[2501];
	int a[51][51]={0},book[51][51]={0};
	int next[4][2]={0,1, 1,0, 0,-1, -1,0};
	int head,tail;
	int i,j,k,n,m,sx,sy,ex,ey,tx,ty,flag;
	scanf("%d%d",&n,&m);
	for(i=1;i<=n;i++)
		for(j=1;j<=m;j++)
			scanf("%d",&a[i][j]);
	scanf("%d%d%d%d",&sx,&sy,&ex,&ey);
	head=1;  tail=1;//队列初始化
	que[tail].x=sx;
	que[tail].y=sy;
	que[tail].s=0;
	tail++;
	book[sx][sy]=1;
	flag=0;
	while(head<tail)
	{
		for(k=0;k<4;k++)
		{
			tx=que[head].x+next[k][0];
			ty=que[head].y+next[k][1];
			if(tx<1||tx>n||ty<1||ty>m)
				continue;
			if(a[tx][ty]==0&&book[tx][ty]==0)
			{
				book[tx][ty]=1;
				que[tail].x=tx;
				que[tail].y=ty;
				que[tail].s=que[head].s+1;
				tail++;
			}
			if(tx==ex&&ty==ey)
			{
				flag=1;
				break;
			}
		}
		if(flag==1)
			break;
		head++;
	}
	printf("%d",que[tail-1].s);//tail指向队列队尾的下一个位置,所以需要-1.
	return 0;
}

 

评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值